# -*- coding: utf-8 -*-
################
#命令模块,负责在下位机与上位机之间传递命令
#################

import sendAndRecevice as sar
import time

#使用单片机还原
def solve(res):
    cmd="res "+res+" #";
    sar.sendData(cmd);

#旋转手臂
def turnArm(num,dir,angle):
    cmd="d"+str(num)+" "+dir+" "+str(angle)+" #";
    sar.sendData(cmd);

#爪子运动
def setClawState(state1,state2):
    cmd="claw "+state1+" "+state2+" #";
    sar.sendData(cmd);

#归位
def toZeroLoc():
    cmd="toZeroLoc #";
    sar.sendData(cmd);
    
def initCubeNum():
    cmd="initCube #";
    sar.sendData(cmd);

#获取电机旋转的周期
def getCycle():
    cmd="config get cycle #";
    sar.sendData(cmd);
    
#获取电机旋转的周期
def setCycle(cycle):
    cmd="config set cycle "+cycle+" #";
    sar.sendData(cmd);

